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r'  The  Advanced  Gun  Fire  Control  System  (AGFCS)  program  is  a multi-phase 
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ness, complexity  and  mission  requirements  of  a post-1976  air  superiority 
aircraft.  The  purpose  of  Phase  II,  the  AGFCS  Design  Study,  was  to  design ... 
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Continued  - Block  20  (Abstract) 

an  Augmented  Tracking  System  (ATS)  for  possible  fabrication  and  flight 
test  evaluation  in  a later  AGFCS  Program  Phase.  The  ATS  includes  the 
range  and  angle  tracking  sensors,  the  computer,  and  the  software  used  to 
process  the  tracking  signals.  It  provides  the  target-dependent  variables 
required  to  solve  the  lead  angle  equation  in  a director  AGF'"S  mechanixation. 
The  ATS  will  ultimately  serve  as  the  core  of  an  advanced  gun  fire  control 

svsten.  ^ 

■( 

The  selected  configuration  serves  as  the  basic  element  of  a nodular 
advanced  gun  fire  control  system.  Its  salient  feature  is  the  use  of 
strapdown  sensors  in  both  the  angle  tracking  and  range  tracking  systems. 

Tlic  angle  sensor  is  the  Bendix  Corporation  Adaptive  Scan  Optical  Tracker 
(ASCOT) ; the  range  sensor  is  the  General  Electric  Solid  State  Radar  (SSR-1) . 
Both  sensors  satisfy  the  requirements  of  the  ATS  application  and  have 
adequate  technical  maturity  for  ti‘..ely  fabrication  and  flight  test.  The 
principal  ATS  subsystem  and  software  features  are: 

o Principal  Subsystems 

o Bendix  Adaptive  Scan  Optical  Tracker 
o G£  Solid-State  Radar 
o ATS  Digital  Computer 
o Strapdown  Gyro/Accelerometer  Package 

o Software  Features 

o Kalman  Angle  Tracking  Filter 
o Kalman  Range  rr^'.^'king  Filter 
o Director  Gun  Fire  Control  Equations 


UNCUSSIFIED 
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SECTION  1 INTRODUCTION  AND  SUMMARY 


1.1  INTRODUCTION 

This  volume  describes  the  ATS  software  design.  Documentation  is 
presented  in  the  form  of  computer  subroutine  flow  charts.  FORTRAN  notatioi. 
is  used  throughout  and  detailed  descriptions  of  the  flow  charts  and  their 
contents  are  provided  to  aid  assembly  language  programming  in  subsequent 
AGFCS  program  phases.  Interface  of  the  ATS  computer  with  the  individual 
sensors  is  discussed  in  Section  3 of  the  AGFCS  Phase  II  final  report. 

1.2  SUMMARY 

The  ATS  software  is  separated  into  four  subroutines: 

0 RTRACK  - contains  the  ATS  Kalman  Range  Tracking  Filter  algorithms 
and  the  logic  for  ATS  computer  interface  with  the  SSR-1  radar. 

0 ATRACK  - contains  the  ATS  Kalman  Angle  Tracking  Filter  algorithms 
and  the  logic  for  ATS  computer  interface  with  the  ASCOT  angle  sensor. 

0 FCU  - contains  the  filter  coordinate  system  update  algorithms  as 
well  as  the  generation  of  ASCOT  pointing  commands. 

o DIRSGT  - contains  the  ATS  director  sight  algorithms  used  for 
lead  angle  computations. 

These  subroutines  are  documented  in  Sections  2,  3,  4 and  5 respectively, 
and  are  presented  in  their  calling  sequence. 

A symbol  definition  table  is  presented  in  an  appendix.  This  table 
presents  in  alphabetical  order  each  FORTRAN  symbol  used  in  the  ATS  software, 
its  definition,  updating  subroutine  and  value  (when  appropriate). 
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SECTION  2 SUBROUTINE  RTRACK  DESCRIPTION 


2.1  RTRACK  FLOW  CHART 

The  RTRACK  flow  chart  is  presented  as  Figure  1.  For  convenient 
reference  it  is  located  at  the  end  of  this  section.  Subsequent  subsections 
discuss  Figure  1 in  detail. 

2 . 2 RESET  MODE 

A reset  mode  is  provided  to  automatically  reset  the  logic  and  parameters 
of  the  individual  ATS  subroutines  at  the  operator's  discretion.  In  the 
case  of  R'^RACK  IRESET  = 1: 

o Sets  the  following  control  switches:  lAUTOR  = 1;  lAUGR  = 0 

0 Sets  the  following  counter  to  zero:  NTRKR 

0 Sets  the  following  counter  limits:  MSMR  = 2,  MEXTR  » 128 

o Initializes  the  average  target  range  to  zero:  GPTRXA  =*  0 

o Initializes  the  driving  noise  covariance  measurement  element: 

SVATR;  and 

o Computes  constants  used  in  the  state  transition  matrices. 

2.3  INITIAL  ACQUISITION  AND  STEADY-STATE  TRACKING  MODE 

To  describe  the  operation  of  RTRACK  during  initial  acquis: tion  it  is 
assumed  that  the  computer  has  been  previously  reset  and  is  now  in  operate 
(IRESET  = 0) . Initially  the  SSR-1  radar  has  not  detected  and  acquired  a 
target  so  that  lACQR  - 0.  Note  that  lAUTOR  * 1 and  lAUGR  =»  0 from  reset  and, 
therefore,  the  radar  .'.s  operating  in  its  autonomous  mode.  In  this  situation, 
the  sole  function  of  RTRACK  is  to  provide  fixed  values  of  range,  range  rate 
and  target  acceleration  along  the  line  of  sight  to  other  subroutines.  These 
fixed  values  have  been  selected  to  be  2000  feet,  -200  feet/second  and  zero 
respectively. 

Wlien  the  SSR-1  has  detected  and  acquired  a target  (ILOCK  =*  1 and 
lEXTR  = 0)  lACQR  is  set  to  1.  This  event  signals  the  start  of  the  initial- 
ization of  RTRACK.  RTRACK  reaches  its  steady  state  operation  after  eight  (8) 
passes  (assuming  lACQR  remains  at  1),  each  pass  taken  at  1/64  second 
intervals.  The  next  few  paragraphs  describe  important  features  of  the 
first  nine  initial  acquisition  passes. 


8 


2.3.1  Initial  Acquisition  Pass  1 


lACQR  = 1 establishes  the  f allowing  values  of  control  switches, 
counters,  and  counter  limits: 

o Control  Switches: 

lAUTOR  = 0 - Commands  the  SSR-1  to  leave  its  Autonomous  Mode. 

lAUGR  = 1 - Commands  the  SSR-1  to  enter  its  Augmented  Mode. 

INTRKR  * 1 - Indicates  range  tracking  filter  is  in  its  initialization 

pass. 

IFRSTR  = 1 - Indicates  that  this  is  the  first  update  sequence  after 
radar  acquisition. 

o Counters: 

NTRKR  = 1 - Indicates  range  tracking  filter  is  operating. 

NSMR  = 0 - NSMR  is  the  counter  on  the  smoothing  performed  on 
measured  range.  During  normal  operation  four  (A) 
samples  taken  at  1/64  second  intervals  are  smoothed 
(averaged)  and  used  to  update  the  Kalman  range  tracking 
filter  every  1/16  second. 

NPREDR  = 0 - NPREDR  is  the  counter  which  sequences  the  Kalman  filter 
update.  The  Kalman  range  tracking  filter  update  occurs 
every  fourth  pass  and  only  when  NPREDR  = 3 (5  on 
initialization  pass  only).  This  counter  is  initialized 
to  zero  so  that  the  filter  cycle  is  entered  properly. 

NEXTR  = 0 - NEXTR  is  the  counter  which  accumulates  extrapolation 
time. 

0 Counter  Limits: 

MAVGR  = 4 - MAVGR  is  used  to  indicate  the  number  of  samples  used 
in  data  smoothing.  It  is  equal  to  4 except  upon 
entering  the  extrapolate  mode  after  loss  of  target 
return. 

MPREDR  = 4 - MPREDR  is  used  to  time  the  update  cycle  of  the  Kalman 
range  tracking  filter.  It  is  set  to  a value  one  less 
than  the  number  of  1/64  second  prediction  intervals 
between  eaci.  filter  update.  Normally  MPREDR  = 2 since 
there  are  three  (3)  prediction  intervals  for  every 
filter  update.  However,  during  initialization  there 
are  five  (5)  prediction  cycles  and  one  Kalman  filter 
update  cycle. 


Since  INTRKR  = 1 the  range  filter  state  variables  are  initialized  at 

the  neasured  radar  range  and  range  rate  and  a priori  acceleration  (zero). 

The  range  covariance  teatrix  is  initialized  as  a diagonal  ssatrix  with  ^ 

diagonal  elenents  SMRPl(l)  = 02;  SHKPi(2)  = (16  c_)2;  SJ*aPI(3)  * 32.22, 

R R 

Since  NPREDR  = 0 and  not  greater  than  HPSEDR  = 4,  the  64  Hz  prediction 
branch  is  entered  and  XPREDR  is  incresented  to  1.  Those  eienents  of  the 
1/64  second  transition  natrix  dependent  upon  iine-of-sight  rate  arc  conpatec 
based  upon  its  most  recent  estisate.  The  target  range  and  range-rate  are 
predicted  1/64  second  into  the  future  assusing  zero  target  acceleration,  h 
range  measuresent  is  taken  at  tise  1/64  second  and  the  predicted  range, 
GPTSFP(i),  is  then  transnitted  to  the  radar  and  loaded  into  its  range 
register  via  the  lAUGR  = 1 control  switch.  Simultaneously  the  values  of 
t:  and  3 are  set  to  1 and  0 respectively  in  the  SSR-1  via  the  lAUGP  = 1 
control  switch. 

2.3.2  Initial  Acquisition  Pass  2 

NTRKR  is  incremented  to  2 and  will  be  incresented  by  one  each  suc- 
ceeding pass  unless  radar  acquisition  is  lost  and  the  radar  fails  to 
reacquire  during  the  fixed  (2  second)  tracking  filter  extrapolation  period. 
INIRKR  is  set  to  zero  and,  since  the  norsal  initial  acquisition  sequence 
is  being  considered  here,  lACQR  is  1.  XEXTR  is  set  to  zero  since  the 
Extrapolate  mode  is  not  being  executed.  SS®  * 0 and  is  not  greater  than 
MSMR  = 2 so  the  most  recent  measurement  of  range  is  added  to  accjsulated 
measurements  (which  were  set  to  zero  during  reset).  NSMR  is  incremented  to 
1. 


INTRKR  = 0 so  NSMR  is  tested  to  determine  whether  or  not  the  KalTaan 
gains  are  to  be  computed.  These  gains  are  computed  every  fourth  cycle  and 
only  when  NSMR  =0.  At  this  point  one  radar  measurement  has  been 
accumulated  for  smoothing  and  NSMR  =1.  NSMR  will  be  set  to  zero  only 
after  four  measurements  have  been  accumulated  and  averaged;  i.e.,  on  Pass  5. 

Since  NPREDR  = 1 which  is  not  greater  chan  MPREDR  = 4,  the  64  Hz 
branch  is  entered  and  NPREDR  is  incremented  to  2.  As  before,  the  latest 
values  of  estimated  line-of-sight  rate  are  used  to  predict  range  and  range- 
rate  1/64  second  into  the  future. 

IFRSTR  = 1 and  NSMR  = 1 so  the  predicted  values  of  range  and  range- rate 
are  stored.  It  is  noted  that  these  are  values  predicted  2/64  second  from 
the  point  of  initial  acquisition.  Finally,  IFRSTR  is  set  to  zero,  a range 
measurement  is  taken  and  the  predicted  range  is  sent  to  SSR-1  to  be  loaded 
into  its  range  register. 

2.3.3  Initial  Acquisition  Pass  3 

As  in  Pas.-  2,  INTRKR  is  set  to  zero,  lACQR  = 1 and  NEXTR  is  set  to  zero, 
ihese  conditions  will  repeat  on  every  pass  considered  hereafter  until  radar 
loss  of  lock  is  considered  (lACQR  = 0).  Therefore,  these  steps  will  not  be 
explicitly  considered  in  future  passes  of  the  initial  acquisition. 
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3£ISKR  i£  increaented  to  3 and  XSNR  * 1 which  is  not  greater  Chan 
HSft  » 2,  so  the  nose  recent  radar  range  neasurenent  is  added  to  those 
previously  acciaulated.  XSHR  is  increaented  to  2. 

XSMR  # 0 and,  since  NPSEDR  > 2 idiich  is  not  greater  than  MfSEDR  » 4, 
XPREDR  is  incr«ae»ted  to  3.  Target  range  and  range  rate  are  then  predicted 
1/64  second  into  the  future.  A range  aeasureaent  is  taken  and  the  predicted 
range  is  sent  to  SSRrl  Co  be  loaded  into  its  range  register. 

2.3.4  Initial  Acquisition  Pass  4 

XTRKR  is  increaented  to  4 and  NSMR  = 2 which  is  not  greater  than 
KSMR  s 2 so  the  most  recent  radar  range  aeasureaent  is  added  to  those 
previously  accunulated.  XSMR  is  increaented  to  3.  It  is  noted  chat  at 
this  point  three  radar  range  aeasureaents,  each  taken  at  1/64  second 
intervals,  have  now  been  accumulated  since  the  initial  aeasureaent.  Thus, 
the  next  aeasureaent  will  collate  the  four  sample  aeasureaents  used  for 
providing  a saoothed  aeasureaent  at  4/64  » 1/16  second  intervals. 

XSHR  # 0 and,  since  NPREDR  3 i^ich  is  not  greater  than  MPREDR  = 4, 
XPREDR  is  incranented  to  4.  Target  range  and  range  rate  are  then  predicted 
1/64  second  into  the  future.  A range  aeasureaent  is  taken  and  the  predicted 
range  is  sent  to  SSR-1  to  be  loaded  into  its  range  register. 

2.3.5  Initial  Acquisition  Pass  5 

NTRKR  is  increaented  to  5 and  NSMR  = 3 which  is  greater  than  MSMR  = 2 
so  the  most  recent  radar  range  measurement  is  added  to  the  three  previously 
accumulated  measurements  and  the  total  is  divided  by  NAVGR  = 4 to  provide 
a smoothed  measurement  valid  2/64  of  a second  after  initial  acquisition. 
Radar  signal-to-noise  ratio  is  measured  and  the  variance  of  the  smoothed 
measurement  is  computed  as  a function  of  the  signal-to-noise  ratio  and 
Che  number  of  measurements.  NSMR  is  set  to  0 and  MAVGR  is  set  to  4. 


NSMR  = 0 and  NEXTR  = 0,  therefore  the  Kalman  gains  will  be  computed 
based  iipon  the  smoothed  signar-to-noise  ratio  and  the  a priori  covariance 
matrix.  The  range  residual  is  then  computed  from  the  smoothed  range 
measurements  computed  on  this  pass  and  the  predicted  range  measurements 
computed  and  stored  on  Pass  2.  It  is  noted  that  the  residual  computed  is 
valid  at  the  point  in  time  2/64  second  after  initial  acquisition.  The 
accumulated  range  measurements  are  then  reset  to  zero. 

Since  NPREDR  = 4 and  not  greater  than  MPREDR  = 4,  NPREDR  is  incremented 
to  5.  Target  range  and  range  rate  are  then  predicted  1/64  second  into  the 
future.  A range  measurement  is  taken  and  the  predicted  range  is  sent  to 
SSR-1  to  be  loaded  into  its  range  register. 


2.3.6  Initial  Acquisition  Pass  6 

STRKR  is  incresiented  to  6 and  NSMR  = 0 which  is  not  greater  than 
MSMR  = 2 so  the  most  recent  radar  range  measurement  is  added  to  the 
accumulated  measurements  (which  were  set  to  zero  on  the  previous  pass) . 
XSMR  is  incremented  to  1. 

NSMR  4 0 but  NPREDR  = 5 and  is  greater  than  MPREDR  = 4,  so  that  the 
16  Hz  Kalman  Range  Tracking  Filter  update  path  is  entered  for  the  first 
time. 


First  NPREDR  is  set  to  zero  and  MPREDR  is  set  to  2.  This  initializes 
the  64  Hz  prediction  path  counter  and  sets  its  limit  so  that  the  prediction 
patli  is  entered  three  times  for  every  one  range  tracking  filter  update  path 
entry.  Note  that  since  this  is  the  sixth  pass  the  prediction  path  has 
been  entered  five  times  and  5/64  seconds  have  transpired  since  initial 
acquisition. 

Next,  the  1/16  second  state  transition  matrix  is  updated  based  upon  the 
most  recent  line-of-sight  rate  information. 

The  Kalman  gains  and  residual  computed  during  the  fifth  pass  together 
with  the  predicted  range  state  stored  on  the  second  pass  are  used  to  update 
the  estimated  range  state  vector.  This  estimated  range  state  vector  is 
valid  for  the  point  in  time  2/64  second  after  initial  acquisition.  These 
estimates  and  measured  ownship  incremental  velocity  along  the  line-of-sight 
are  then  used  to  predict  the  state  vector  1/16  second  into  the  future 
(6/64  second  after  initial  acquisition).  Thus,  the  predicted  range  state 
coincides  with  the  start  of  the  seventh  pass.  After  updating  the 
predicted  state  vector,  the  estimation,  SMRE,  and  prediction,  SMRP, 
covariance  matrices  are  updated.  A range  measurement  is  taken  and  the 
predicted  range  is  sent  to  the  SSR-1  to  be  loaded  into  its  range  register. 
The  predicted  range  and  range  rate  are  used  for  the  1/64  second  range 
prediction  during  the  interval  until  the  next  Kalman  filter  update. 

2.3.7  Initial  Acquisition  Pass  7 

NTRKR  is  incremented  to  7 and  NSMR  = 1 which  is  not  greater  than 
MSMR  = 2 so  the  most  recent  radar  range  measurement  is  added  to  those 
previously  accumulated.  NSMR  is  incremented  to  2. 

NSMR  4 0 and,  since  NPREDR  - 0 which  is  not  greater  than  MPREDR  (which 
was  set  to  2 on  the  previous  pass),  NPREDR  is  incremented  to  1.  Target 
range  and  range  rate  are  then  predicted  1/64  second  into  the  future.  A 
range  measurement  is  taken  and  the  predicted  range  is  sent  to  SSR-1  to  be 
loaded  into  its  range  register. 
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2.3.8  Initial  Acquisition  Pass  8 

NTRXR  is  incremented  to  8 and  NSMR  = 2 which  is  not  greater  than 
MSMR  = 2 so  the  most  recent  radar  range  measurement  is  added  to  the  two 
previously  accumulated.  NSMR  is  incremented  to  3. 

Since  NPREDR  = 1 which  is  not  greater  than  NPREDR  =2,  NPREDR  is 
incremented  to  2.  Target  range  and  range  rate  are  predicted  1/64  second 
into  the  future.  A range  measurement  is  taken  and  the  predicted  range  is 
sent  to  SSR-1  to  be  loaded  into  its  range  register. 

2.3.9  Initial  Acquisition  Pass  9 

NTRKR  is  incremented  to  9 and  NSMR  = 3 which  is  greater  than  MSMR  = 2 
so  the  most  recent  radar  range  measurement  is  added  to  the  three  previously 
accumulated  measurements  and  the  total  is  divided  by  MAVGR  = 4 to  provide  a 
smoothed  measurement  occurring  6/64  seconds  after  initial  acquisition. 

Radar  signal- to-noise  ratio  is  measured  and  the  variance  of  the  smoothed 
measurement  is  computed  as  a function  of  the  signal- to-noise  ratio  and  the 
number  of  measurements.  NSMR  is  reset  to  zero  and  MAVGR  is  set  to  4. 

NSMR  = 0 and  NEXTR  « 0,  therefore,  the  Kalman  gains  will  be  computed 
based  on  the  smoothed  signal- to-noise  ratio  and  the  predicted  covariance 
matrix  computed  on  Pass  6.  The  range  residual  is  then  computed  from  the 
smoothed  range  measurements  computed  on  this  pass  and  the  predicted  range 
measurements  computed  on  Pass  6,  i.e.,  the  range  tracking  filter  update 
pass.  It  is  noted  that  the  residual  computed  is  valid  at  the  point  in 
time  6/64  second  after  initial  acquisition.  The  accumulated  range  measure- 
ments are  then  reset  to  zero. 

Since  NPREDR  = 2 and  is  not  greater  than  MPREDR  = 2,  NPREDR  is 
incremented  to  3.  Target  range  and  range  rate  are  then  predicted  1/64  second 
into  the  future.  A range  measurement  is  taken  and  the  predicted  range  is 
sent  to  SSR-1  to  be  loaded  into  its  range  register. 

2.3.10  Steady-State  Tracking 


After  the  eighth  pass,  i.e.,  8/64  second  after  initial  acquisition, 
RTRACK  is  operating  in  its  steady-state  sequence.  Pass  9 was  identical  to 
Pass  5;  Pass  10  would  be  identical  to  Pass  6;  Pass  11  would  be  identical 
to  Pass  7 and  Pass  12  would  be  identical  to  Pass  8.  The  next  radar  tracking 
filter  update  will  occur  on  Pass  10  - 9/64  second  after  initial  acquisition. 
The  next  measurement  average  will  occur  on  Pass  13  - 12/64  second  after 
initial  acquisition. 

This  cycle  will  be  repeated  every  1/16  second  until  interrupted. 
Interruption  can  occur  either  by  resetting  the  computer  (IRESET  = 1)  or 
by  loss  of  radar  lock-on  (lACQR  = 0).  The  operation  of  the  Reset  mode  has 
been  previously  discussed.  The  RTRACK  Extrapolate  mode  used  after  radar 
break-lock  is  discussed  in  the  next  section. 


2,4  EXTRAPOLATION  MODE 

The  Extrapolation  mode  is  implemented  to  provide  a search  zone  command 
and  to  aid  in  reacquisition  after  loss  of  radar  lock-on.  Loss  of  radar 
lock-on  is  signalled  by  the  SSR-1  setting  the  discrete  lEXTR  to  one.  lACQR 
is  therefore  set  to  zero.  If  two  or  more  seconds  of  steady-state  tracking 
has  occurred  prior  to  loss  of  lock-on,  the  Extrapolation  mcle  will  be 
entered.  If  less  than  two  seconds  of  steady-state  tracking  has  occurred, 
the  SSR-1  is  commanded  to  its  Autonomous  Mode  (lAirTOR  = 1 and  lAUGR  = 0) . 

In  the  following  subsections  the  detailed  operational  sequence  of 
RTRACK  will  be  discussed  on  a pass  by  pass  basis  after  loss  of  radar  lock-on 
(assuming  two  or  more  seconds  of  steady-state  tracking  has  occurred) . 


2,4.1  Extrapolation  Mode  Pass  1 


NTRKR  is  greater  than  zero  but  lACQR  = 0 so  the  data  smoothing  branch 
is  by-passed  and  the  extrapolation  branch  is  entered.  NEXTR  is  incremented 
to  1. 


Since  NEXTR  is  lass  than  MEXTR  = 128,  the  accumulated  measurements  are 
zeroed  and  NSMR  is  tested  against  MSMR  = 2.  NSMR  can  be  any  integer  value 
from  0 to  3 and  is  incremented  each  pass  in  a manner  identical  to  that  used 
during  data  smoothing.  This  provides  proper  sequencing  for  possible 
subsequent  reacquisition.  For  the  same  reason  MAVGR  is  set  to  (4  - NSMR) 
so  that  an  incomplete  set  of  measurements  can  be  accommodated  during 
reacquisition.  In  the  following  paragraphs  the  effect  of  each  possible 
NSMR  value  on  the  first  pass  of  the  extrapolate  mode  will  be  discussed. 


2. 4. 1.1  NSMR  = 0 - NSMR  is  incremented  to  1 and  MAVGR  is  set  to  3.  NSMR 

is  not  equal  to  zero  and  NPREDR  = 3 which  is  greater  than  MPREDR  = 2. 

Therefore,  NPREDR  is  reset  to  zero  and  the  Kalman  range  tracking  filter  is 
updated  based  on  the  last  complete  set  of  measurements  taken  prior  to  loss 
of  radar  lock-on.  The  tracking  filter  update  is  accomplished  in  the  same 
manner  as  in  Subsection  2.3.6.  Since  lAUGR  = 1 and  lAUTQR  = 0,  the  SSR-1 
will  search  in  a +100  feet  range  gate  centered  about  the  predicted  range. 

2. 4. 1.2  NSMR  = 1 - NSMR  is  incremented  to  2 and  MAVGR  is  set  to  2.  NSMR 

is  not  equal  to  zero  and  NPREDR  = 0 which  is  not  greater  than  MPREDR  = ? 

(see  Subsection  2.3.7).  Therefore,  NPREDR  is  incremented  to  1 and  target 
range  and  range  rate  are  predicted  1/64  second  into  the  future  and  loaded 
into  the  SSR-1  range  register. 

2. 4.]. 3 NSMR  = 2 - NSMR  is  incremented  to  3 and  MAVGR  is  set  to  1.  NSMR 
is  not  equal  to  zero  and  NPREDR  = 1 which  is  not  greater  MPREDR  = 2.  (See 
Subsection  2.3.8).  Therefore,  NPREDR  is  incremented  to  2 and  target  range 
and  range  rate  are  predicted  1/64  second  into  the  future  and  loaded  into 
the  SSR-1  range  register. 
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2. 4. 1.4  NSMR  = 3 - NSMR  is  greater  than  MSMR  = 2 so  NSMR  is  reset  to  zero 
and  MAVGR  is  set  to  4.  NSMR  = 0 and  NEXTR  is  greater  than  zero  so  the 
Kalman  gains  are  zeroed.  NPREDR  = 2 which  is  not  greater  than  HPREDR  = 2 
(see  Subsection  2.3.9).  Therefore,  NPREDR  is  incremented  to  3 and  target 
range  and  range  rate  are  predicted  1/64  second  into  the  future  and  loaded 
into  the  SSR-1  range  register. 


2.4.2  Extrapolation  Mode  Pass  2 


This  branching  of  Pass  2 is  dependent  on  the  value  of  NSMR  on  the  first 
pass.  Therefore,  as  in  the  previous  subsection,  each  possible  situation  will 
be  discussed  below. 


2.4.2. 1 NSMR  = 0 - NSMR  = 0 corresponds  to  the  situation  for  which  NSMR  * 3 
on  Che  first  pass  of  the  Extrapolate  mode  (see  Subsection  2. 3. 1.4).  NSMR 
is  incremented  to  1.  NSMR  is  not  equal  to  zero  and  NPREDR  * 3 which  is 
greater  than  MPREDR  = 2.  Therefore,  NPREDR  is  reset  to  zero  and  the  Kalman 
range  tracking  filter  is  updated  based  on  zero  Kalman  gains.  The  range 
state  vector  is  extrapolated,  the  covariance  matrices  are  updated  and  the 
predicted  range  is  loaded  into  the  SSR-1  range  register. 


2. 4. 2. 2  NSMR  = 1 - NSMR  = 1 corresponds  to  the  situation  for  which  NSMR  * 0 
on  the  first  pass  of  the  Extrapolation  mode  (see  Subsection  2. 3. 1.1).  NSMR 
is  incremented  to  2.  NSMR  is  not  equal  to  zero  and  NPREDR  = 0 which  is  not 
greater  than  MPREDR  = 2.  Therefore,  NPREDR  is  incremented  to  1 and  target 
range  and  range  rate  are  predicted  1/64  second  into  the  future  and  the 
SSR-1  range  registers  loaded  as  before. 


2. 4. 2. 3  NSMR  = 2 - NSMR  = 2 corresponds  to  the  situation  for  which  NSMR  = 1 
on  the  first  pass  of  the  Extrapolation  mode  (see  Subsection  2. 4. 1.2).  NSMR 
is  incremented  to  2.  NSMR  is  not  equal  to  zero  and  NPREDR  = 1 which  is 
not  greater  than  MPREDR  = 2.  Therefore,  NPREDR  is  incremented  to  2 and 
target  range  and  range  rate  are  predicted  1/64  second  into  the  future  and 
the  SSR-1  range  register  is  loaded  as  before. 


2. 4. 2. 4 NSMR  = 3 - NSMR  = 3 corresponds  to  the  situation  for  wh^ch  NSMR  = 2 
on  the  first  pass  of  the  Extrapolation  mode  (see  Subsection  2. 4. 1.3). 

NSMR  is  greater  than  MSMR  = 2 so  NSMR  is  reset  to  zero  and  MAVGR  is  set 
to  4.  NSMR  is  equal  to  zero  and  NEXTR  not  equal  to  zero  so  the  Kalman 
gains  are  zeroed.  NPREDR  = 2 which  is  not  greater  than  MPREDR  = 2 so 
NPREDR  is  incremented  to  3 and  target  range  and  range  rate  are  predicted 
1/64  second  into  the  future  and  the  SSP-1  range  register  is  loaded  as 
before. 


2.4.3  Extrapolation  Mode  Passes  3 - 128 


Reviewing  the  previous  two  subjections  reveals  that  essentially  three 
actions  are  performed;  1)  prediction  using  the  1/64  second,  zero  accelera- 
tion algorithm;  2)  zeroing  the  Kalman  gains;  and  3)  updating  the  Kalman 
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filter.  The  pass  on  which  these  actions  occur  as  a function  of  SSHR  on  the 
first  pass  is  shown  in  Table  1 based  on  the  previous  discussion  for  the 
first  two  passes  and  on  similar  reasoning  for  future  passes. 

Note  that  by  Pass  4 an  update  of  the  Kalman  filter  will  have  been  made 
in  all  cases.  This  corresponds  to  prediction  (extrapolation)  by  the  Kaltnan 
ilter  algorithm.  Also,  it  is  noted  that,  if  NS>5R  = 0 or  the  first  pass,  a 
r liman  filter  update  is  made  prior  to  zeroing  the  Kalman  gains.  This 
provides  for  effective  utilization  of  radar  measurements  taken  prior  to 
break- lock. 

If  lock-on  is  not  re-established  within  123  passes  (2  seconds),  NEXTR 
will  exceed  MEXTR  = 128.  This  sets  the  following  control  logic: 

o NTRKR  = 0 - Indicates  loss  of  range  tracking  filter. 

o NEXTR  = 0 - Resets  NEXTR. 

o lAUTOR  = 1 - Commands  autonomous  SSR-1  operational  mode. 
lAUGR  = 0 

If  lock-on  is  re-established  by  the  SSR-1  within  128  passes,  lACQR 
is  set  to  1 when  lEXTR  becomes  zero  and  RTRACK  enters  its  Reacquisition  mode. 
This  mode  is  discussed  in  the  next  subsection. 
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TABLE  1 

EXTRAPOLATION  SEQUENCE  SUMMARY 


Pint  Pa« 
NSMR 

Extrapolation  Pass 

1 

2 

3 

4 

5 

6 

0 

UD 

P 

P 

ZG&P 

UD 

P 

1 

P 

P 

ZG&P 

UD 

P 

P 

2 

P 

ZG&P 

UD 

P 

P 

ZG&P 

3 

ZG&P 

UD 

r 

P 

ZG&P 

UD 

Code  P — Predicted  1/64  sec 
ZG  - Zero  Kalmart  Gatns. 

UD  - Update  Kalman  Filter  and  Predict  1/16  5cc  gp74  0i2?30 


2.5  REACQUISITION  MODE 

Reacquisition  capability  is  provided  in  order  to  take  advantage  of 
predicted  range  rate  and  target  acceleration  information  provided  during 
the  Kalman  Range  Tracking  Filter  extrapolation  cycle.  RTRACK  provides 
automatic  synchronization  of  the  extrapolation  cycle  with  the  newly 
available  radar  measurements  rather  than  completely  recycling  the  filter. 
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This  speeds  the  reacquisition  process  and  provides  for  full  utilization  of 
the  Kalman  filter  memory.  As  in  the  case  of  the  initial  pass  in  the 
Extrapolation  mode,  the  Reacquisition  mode  can  be  initiated  with  NSMR  equal 
to  any  integer  value  from  0 to  3.  Each  of  these  cases  is  treated  below. 

When  lACQR  is  set  to  1 reacquisition  is  initiated.  The  following 
combinations  of  NSMR,  MAVGR  and  NPREDR  are  possible  at  the  beginning  of 
Pass  1:  (0,  4,  3);  (1,  3,  0);  (2,  2,  1);  and  (3,  1,  2).  The  Kalman  filter 

is  updated  only  on  passes  for  which  NPREDR  = 3 and  the  Kalman  gains  are 
computed  only  on  passes  for  which  NSMR  = 3 (at  the  beginning  of  the  pass) . 
These  cases  respectively  correspond  to  the  first  and  fourth  initial 
situations  enumerated  above.  The  values  of  MAVGR  given  above  correspond  to 
the  nund)er  of  measurements  which  will  be  available  for  incorporation  into 
the  range  tracking  filter  at  the  first  possible  synchronized  update  interval 
(non-zero  Kalman  gains) . 

In  the  previous  subsection  it  was  shown  that  the  following  relationship 
occurs  between  NSMR  and  the  principal  actions  taken  during  the  Extrapolation 
mode: 

NSMR  EXTRAPOLATION  MODE 

ACTION 

0 UD 

1 P 

2 P 

3 ZG  & P 

During  the  Reacquisiton  mode  NEXTR  = 0 so  the  only  difference  in 
action  is  that,  instead  of  zeroing  the  Kalman  gains,  they  will  be  computed 
together  with  the  appropriate  residual. 

Thus  Table  2 indicates  the  action  taken  during  Reacquisition  passes 
as  a function  of  the  first  pass  value  of  NSMR.  Synchronization  is  complete 
at  the  first  Kalman  tracking  filter  update  after  computation  of  a non-zero 
set  of  Kalman  gains.  Examination  of  Table  2 indicates  that  the  first  pass 
condition  NSMR  = 3 provides  the  earliest  synchronization  (Pass  2)  while 
NSMR  = 0 provides  the  latest  synchronization  (Pass  5) . The  "price"  of 
early  synchronization  is  that  less  than  a full  set  of  measurements  is 
available  at  the  time  of  update.  For  example,  the  first  pass  condition 
NSMR  = 3 provides  only  one  measurement  at  the  first  range  tracking  filter 
update;  while  NSMR  = 0 provides  a full  set  of  four  measurements.  The 
reacquisition  sequence  for  NSMR  = 3 on  the  initial  pass  is  discussed  in 
detail  in  the  next  subsection. 


2.5.1  Initial  Reacquisition  Pass  NSMR  = 3 


2. 5. 1.1  Pass  1 - NSMR  is  greater  than  MSMR  = 2 so  the  most  recent  radar 
measurement  is  added  to  accumulated  measurements  (which  had  been  zeroed 
during  the  Extrapolation  mode)  and  divided  by  MAVGR  = 1.  Thus,  the 
averaged  measurement  corresponds  to  the  first  available  measurement. 


Radar  signal-to-noise  ratio  is  nes'sured  and  the  variance  of  the  smoothed 
laeasurement  is  computed  as  a function  of  the  signal-to-noise  ratio  ard  the 
number  of  measurements.  NSMR  is  then  reset  to  zero  and  MAVGR  set  to  4. 

INTRKR  — 0,  NSMR  = 0 and  NEXTR  ~ 0 so  the  Kalman  gain  computation 
branch  is  entered.  The  filter  gains  are  then  computed  as  a function  of: 

1)  the  measurement  noise,  which  includes  the  effect  of  sigeal-to-noise 
ratio  and  the  number  of  available  measurements;  and  2)  the  predicted  state 
covariance  matrix,  which  includes  the  effect  of  increasing  uncertainty  in 
-he  predicted  state  variables  during  extrapolation.  The  accumulated  range 
measurements  are  then  reset  to  zero. 

Since  NPREDR  = 2 and  is  not  greater  than  MPREDR  = 2,  the  1/64  second 
prediction  branch  is  entered.  NPREDR  is  Incremented  to  3.  Range  and  range 
rate  are  predicted  1/64  second  into  the  future.  A range  measurenient  is  taken 
and  the  predicted  range  is  sent  to  SSR-1  to  be  loaded  into  its  range  register. 


TABLE  2 

REACQUISITiON  SEQUENCE  SUMMARY 


P - Predicted  1/64  see 

CG  - Compute  Kalman  Gams 

UO  - Update  Kalman  Filter  and  Predict  1/16  sec 


2.5. 1.2  Pass  2 - NSMR  = 0 which  is  not  greater  than  MSMR  = 2 so  the  most 
recent  radar  measurement  is  accumulated  and  NSMR  is  incremented  to  1. 

NSMR  is  not  equal  to  zero  and  NPREDR  = 3 which  greater  than 
MPREDR  = 2 so  the  Kalman  Range  Tracking  Filter  update  branch  is  ente  ed. 
The  Kalman  gains  are  not  zero,  having  been  computed  on  the  previous  pass, 
so  the  residual  is  used  to  update  the  range  state  vector  estimate.  This 
returns  RTRACK  to  its  normal  tracking  cycle. 
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2.5.2  Initial  Reacquisition  Pass  NSMR  - 2 

2.5. 2.1  Pass  1 - NSMR  is  not  greater  than  MSMR  » 2 so  the  most  recent  radar 
measurement  is  accumulated  (GPTRXA  having  been  set  to  zero  during  the 
Extrapolation  mode) . NSMR  is  Incremented  to  3. 

NSMR  is  not  equal  to  zero  and  NPREDR  = 1 which  is  not  greater  than 
MPREDR  = 2,  so  NPREDR  is  incremented  to  1.  Range  and  range  rate  are 
predicted  1/64  second  into  the  future.  A range  measurement  is  taken  and 
the  predicted  range  is  sent  to  SSR-1  to  be  loaded  into  its  range  register. 

2. 5. 2. 2 Pass  2 - NSMR  = 3 which  is  greater  than  MSMR  = 2 so  the  most 
recent  radar  measurement  is  added  to  those  previously  accumulated  and 
divided  by  MAVGR  = 2 (a  total  of  two  measurements  have  been  accumulated  to 
this  point) . Radar  signal~to-noise  ratio  is  measured  and  the  variance  of 
the  smoothed  measurement  is  computed  as  a function  of  the  slgnal-to-nolse 
ratio  and  the  number  of  measurements.  NSMR  is  reset  to  zero  and  MAVGR  to  4. 

INTRKR  = 0,  NSMR  = 0,  and  NSXTR  = 0 so  the  Kalman  gain  computation 
branch  is  entered  and  the  Kalman  gains  and  residual  are  computed  as 
previously  described. 

Since  NPREDR  = 2 which  is  not  greater  than  MPREDR  = 2,  the  1/64  second 
prediction  branch  is  entered.  NPREDR  is  Incremented  to  3,  Target  range 
and  range  rate  are  predicted  1/64  second  into  the  future.  A range  measure- 
ment is  taken  and  the  predicted  range  is  sent  to  SSR-1  to  be  loaded  into 
its  range  register. 

2. 5. 2. 3 Pass  3 - NSMR  = 0 which  is  not  greater  than  MSMR  = 2 so  the  most 
recent  radar  measurement  is  added  to  those  previously  accumulated  (the 
accumulation  was  zeroed  on  the  previous  pass).  NSMR  is  incremented  to  1. 

NSMR  is  not  equal  to  zero  and  MPREDR  = 3 which  is  greater  than 
MPREDR  = 2 so  the  Kalman  range  tracking  filter  update  branch  is  entered. 

The  Kalman  gains  are  not  zero,  having  been  computed  on  the  previous  pass, 
so  the  residual  is  used  to  update  the  range  state  vector  estimate.  This 
returns  RTRACK  to  its  normal  tracking  cycle. 

2.5.3  Initial  Reacquisition  Pass  NSMR  = 1 

This  sequence  is  much  the  same  as  the  previously  discussed  sequence 
except  for  the  first  pass.  The  second  pass  is  identical  to  the  first  pass 
when  NSMR  = 2 on  the  initial  pass.  MAVGR  = 3 to  account  for  the  additional 
range  measurement. 

2.5.4  Initial  Reacquisition  Pass  NSMR  = 0 


This  sequence  is  much  the  same  as  the  previously  discussed  sequence 
except  for  the  first  pass.  The  second  pass  is  identical  to  the  first  pass 
when  NSMR  = 1 on  the  initial  pass.  MAVGR  = 4 to  account  for  the  additional 
range  measurement. 
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FIGURE  1 

SUBROUTINE  RTRACK  FLOW  CHART 
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SECTION  3 SUBROUTINE  ATRACK  DESCRIPTION 


3.1  ATRACK  FLOW  CHART 

The  ATRACK  flow  chart  is  presented  as  Figure  2.  For  convenient 
reference  it  is  located  at  the  end  of  this  sec* ion.  Subsequent  subsections 
discuss  Figure  2 in  detail. 

3.2  RESET  MODE 

A reset  mode  is  provided  to  automatically  reset  the  logic  and  parameters 
of  the  individual  ATS  subroutines  at  the  operator's  discretion.  In  the  case 
of  ATRACK  IRESET  - 1: 

o Sets  the  following  counter: 

NTRKA  « 0 - NTRKA  indicates  whether  ATRACK  is  operating  in  its 

tracking  or  extrapolation  modes.  This  counter  is  zero 
until  ASCOT  detects  a target.  After  ASCOT  detection  it 
counts  the  number  of  passes  during  which  the  tracking 
filter  is  in  continuous  tracking  and  extrapolation. 

o Sets  the  following  counter  limits: 

MSMA  = 8 - MSMA  is  the  limiting  value  of  counter  MSMA,  which  is 
used  to  sequence  the  smoothing  of  ASCOT  measurements. 

MPREDA  = 8 - MPREDA  is  the  limiting  value  of  counter  NPREDA  which 
is  used  to  sequence  the  update  cycle  of  the  Kalman 
Angle  Tracking  Filter. 

MEXTA  = 320  - MEXTA  is  the  limiting  value  of  counter  NEXTA.  NEXTA 
is  the  extrapolation  pass  counter  which  counts  the 
number  of  passes  during  which  che  filter  is  in  continuous 
extrapolation. 

0 Initializes  the  average  ASCOT  error  voltages  and  SGAP  incremental 
velocities  at  zero: 

XDVFA(2)  = XDVFA(3)  = 0 

GVAAFA(l)  = FVAAFA(2)  = GVAAFA(3)  = 0 

o Computes  constants  used  in  the  state  transition  matrix  and  constant 
state  transition  matrix  elements. 


o Initializes  the  driving  noise  covariance  matrix  element:  SVATA 
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3.3  INITIAL  DETECTION  MODE 


To  describe  the  operation  of  ATRACK  during  initial  acquisition  it  is 
assus:cd  that  the  computer  has  been  previously  reset  and  is  now  in  operate 
(IRESET  = 0).  Initially,  ASCOT  has  not  detected  and  acquired  a target  so 
that  IDETA  = 0 and  lACQA  = 0.  Note  Chat  ASCOT  is  operating  in  its  search 
mode.  In  this  situation,  Che  function  of  ATRACK  is  to:  measure  ownship 

incremental  velocities;  2)  provide  incremental  line-of -sight  (LOS)  changes 
(body  attitude  changes)  to  the  Filter  Coordinate  Update  (FCU)  subroutine; 

3)  provide  approximate  LOS  rates  (body  rates)  to  the  RTRACK  subroutine; 
and,  4)  compute  fixed  filter-to-sensor  direction  cosine  matrix  (GCSF)  and 
quaternion  (GQSF). 

When  ASCOT  has  detected  a target  IDETA  is  set  to  1 by  ASCOT.  This 
event  signals  the  start  of  the  initialization  of  ATRACK.  For  a time  after 
detection  (up  to  400  milliseconds)  the  ASCOT  is  in  its  initial  acquisition 
mode.  ATRACK  (assuming  IDETA  remains  1)  cycles  through  its  initial  acquisi- 
tion branch  at  1/160  second  intervals.  The  next  few  paragraphs  describe  the 
important  features  of  each  of  the  initial  detection  passes. 

3.3.1  Initial  Detection  - Pass  1 

IDETA  - 1 establishes  the  following  values  of  control  switches, 
counters  and  counter  limits: 

o Control  switch 

TNTRKA  = 1 - Indicates  the  Angle  Tracking  Filter  is  in  its  initiali- 
zation pass 

o Counters 

NTRKA  = 1 - Indicates  that  the  Angle  Tracking  Filter  i s operating. 

NSMA  = 5 - NSMA  is  the  counter  which  sequences  the  smoothing  of 

ASCOT  measurements.  During  normal  operation  ten  ASCOT 
samples  taken  at  1/160  second  intervals  are  smoothed 
(averaged)  and  used  to  update  the  Kalman  iVngle  Tracking 
Filter  every  1/16  second.  This  counter  is  initialized 
at  five  to  offset  the  filter  by  one  half  of  the  1/16 
second  filter  cycle  interval. 

NPREDA  = 0 - XPREDA  is  the  counter  which  sequences  the  Kalman  filter 
update.  The  Kalman  Angle  Tracking  Filter  update  occurs 
every  tenth  pass  and  only  when  NPREDA  = 9.  This  counter 
is  initialized  at  zero  so  that  the  filter  cycle  is 
entered  properly. 


NEXTA  = 0 - NEXTA  is  the  extrapolation  pass  counter  which  counts  the 
number  of  passes  during  which  the  filter  is  in  continuous 
extrapolation. 
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o Counter  Limits 


MTKKA  » 65  - HXKKA  is  tlie  value  of  NTRXA  at  which,  if  no  target  is 

acquired,  the  ASCOT  will  be  returned  to  its  search  mode. 

A test  of  NTRKA  against  MTRKA  prevents  the  filter  from 
entering  its  extrapolation  mode  before  acquisition. 

MAVGA  = 5 - MAVGA  is  used  to  indicate  the  number  of  ASCOT  samples 

used  in  the  smoothed  ASCOT  measurement.  It  is  equal  to 
ten  except  when  the  filter  is  in  its  extrapolation  mode. 
MAVGA  is  initialized  at  five  because,  given  immediate 
acquisition  after  detection,  the  first  smoothed  ASCOT 
measurement  will  contain  five  samples. 

In  addition  to  the  initialization  of  the  above  control  logic,  the  initial 
filter-to-sensor  direction  cosine  matrix  (GCSF)  and  filter-to-sensor  quaternion 
(GQSF)  are  computed  from  the  ASCOT  deflection  voltages  at  detection. 

In  this  pass  and  in  each  succeeding  1/160  second  pass,  the  measured  SGAP 
incremental  velocities  and  incremental  body  attitude  changes  are  transformed 
to  filter  coordinates.  In  addition,  the  transformed  incremental  velocities 
are  accumulated.  The  accumulated  incremental  velocities  are  reset  to  zero 
after  the  computation  of  the  measurement  residuals. 

Since  INTRKA  = 1 the  Angle  Tracking  Filter  state  variables  are  initiali- 
zed at  their  a priori  values.  The  target  relative  position  states  in  filter 
coordinates  are  set  to  zero  since  the  filter  coordinate  system  was  Initialized 
pointing  at  the  target  at  detection.  The  target  relative  velocity  states  in 
filter  coordinates  are  conq>uted  from  ownshlp  Incremental  body  attitude  changes 
transformed  to  filter  coordinates.  The  target  total  acceleration  states  in 
filter  coordinates  are  Initialized  at  ownship  incremental  velocities  trans- 
formed to  filter  coo’*dinates . The  state  variable  covariance  matrix  is 
initialized  at  fixed  input  values. 

The  Kalman  gains  are  then  zeroed  to  force  the  filter  to  extrapolate 
until  the  target  is  acquired  by  ASCOT  (lACQA  = 1)  and  ASCOT  transitions  into 
its  track  mode. 

Since  NPREDA  « 0,  ASCOT  reorientation  commands  are  computed  such  that 
the  a priori  tracking  error  states,  predicted  1/16  second  into  the  future, 
will  be  nulled.  These  data  are  stored  for  use  after  the  next  four  passes. 
NPREDA  = 0 which  is  not  greater  than  MPREDA  = 8 so  NPREDA  is  incremented  to 
1.  This  completes  the  first  initial  detection  pass. 

3.3.2  Initial  Detection  - Pass  2 

NTRJuV  = 1 after  the  first  pass  and  is  incremented  by  one  each  succeeding 
pass,  unless  the  ASCOT  loses  lock  and  fails  to  reacquire  during  a fixed  (two 
second)  extrapolation  period.  INTRKA  is  set  to  zero  and  remains  zero,  unless 
ASCOT  loses  lock  and  fails  to  reacquire  during  extrapolation.  Since  the 
normal  initial  acquisition  sequence  is  being  considered  presently,  IDETA  = 1 
and  lACQA  = 0.  NEXlA  is  zero  so  the  extrapolation  mode  is  not  being  executed. 
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Since  lACQA  = 0,  NTRiJ^  = 2 which  is  not  greater  than  MTRKA  = 65,  IDETA 
is  not  equal  to  zero  and  NSMA  = 5 which  is  not  greater  than  MSMA  = 8,  NSMA 
is  incremented  to  6 and  MAVGA  decremented  to  4.  NSMA  is  not  equal  to  zero, 
so  the  Kalman  gain  computations  are  bypassed.  NPREDA  = 1 which  is  not  equal 
to  zero  or  greater  than  MPREDA  = 8,  so  NPREDA  is  incremented  to  2.  Note  that 
this  branch  is  basically  an  "idle"  branch.  Its  principal  purpose  is  to  main- 
tain the  proper  sequencing  of  the  logic  such  that  in  the  event  of  ASCOT 
acquisition  (lACQA  = 1)  the  system  will  automatically  tr^Jisition  into  its 
steady  state  tracking  sequence. 

3.3.3  Initial  Detection  - Pass  3 


NTRKA  is  incremented  to  3 which  is  not  greater  than  MTRKA  = 65,  IDETA  = 
1,  NSMA  = 6 which  is  not  greater  than  MSMA  = 8;  hence  NSMA  is  incremented  to 
7,  and  MAVGA  is  decremented  to  3.  NSMA  is  not  equal  to  zero  and  NPREDA  = 2 
which  is  not  zero  or  greater  than  MPREDA  = 8 so  that  NPREDA  is  incremented 
to  3. 


3.3.4  Initial  Detection  - Pass  4 


NTRKA  is  incremented  to  4 which  is  not  greater  than  MTRKA  = 65,  IDETA  = 
1,  NSMA  = 7 which  is  not  greater  than  MSMA  = 8;  hence  NSMA  is  incremented 
to  8 and  MAVGA  is  decremented  to  2.  NSMA  is  not  equal  to  zero  and  NPREDA  = 

3 which  is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is  incremented  to  4. 

3.3.5  Initial  Detection  - Pass  5 


NTRKA  is  incremented  to  5 which  is  not  greater  than  MTRKA  ■ 65,  IDETA  ■ 
1,  NSMA  = 8 which  is  not  greater  than  MSMA  = 8;  hence  NSMA  is  incremented  to 
9 and  MAVGA  is  decremented  to  1.  NSMA  is  not  equal  to  zero  and  NPREDA  = 4 
which  is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is  incremented  to  5. 

3.3.6  Initial  Detection  - Pass  6 


NTRKA  is  incremented  to  6 which  is  not  greater  than  MTRKA  » 65,  IDETA  = 
1,  NSMA  = 9 which  is  greater  than  MSMA  = 8;  so  that  NSMA  is  reset  to  zero 
and  MAVGA  to  10.  NSMA  = 0 so  the  ASCOT  reorientation  commands  computed  on 
Pass  1 are  sent  to  the  Filter  Coordinate  Update  subroutine.  lACQA  is  equal 
to  zero  so  the  Kalman  gains  are  zeroed.  NPREDA  = 5 which  is  not  zero  or 
greater  than  MPREDA  = 8 so  NPREDA  is  incremented  to  6. 

3.3.7  Initial  Detection  - Pass  7 


NTRKA  is  incremented  to  7 which  is  not  greater  than  MTRKA  = 65 , IDETA  = 
1,  NSMA  = 0 which  is  not  greater  than  MSMA  - 8;  so  NSMA  is  incremented  to  1 
and  MAVGA  decremented  to  9.  NSMA  is  not  equal  to  zero  and  NPREDA  = 6 which 
is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is  ir cremented  to  7. 
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3.3.8  Initial  Detection  - Pass  8 


NTKKA  Is  incremented  to  8 which  is  not  greater  than  MTRKA  = 65,  IDETA  = 
1,  NSMA  “ 1 which  is  not  greater  than  MSMA  = 8;  so  NSMA  is  incremented  to  2 
and  MAVGA  is  decremented  to  8.  NSMA  is  not  equal  to  zero  and  NPREDA  » 7 
which  is  not  zero  or  greater  than  MPREDA  8 so  NPREDA  is  incremented  to  8. 

3.3.9  Initial  Detection  - Pass  9 


NTRKA  is  incremented  to  9 which  is  not  greater  than  MTRKA  ■=  65,  IDETA  = 
1,  NSMA  = 2 which  is  not  greater  than  MSMA  * 8;  so  NSMA  is  incremented  to  3 
and  MAVGA  is  decremented  to  7.  NSMA  is  not  equal  to  zero  and  NPREDA  = 8 
which  is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is  incremented  to  9. 

Note  that  elapsed  time  to  this  point  since  detection  is  9/160  seconds. 

3.3.10  Initial  Detection  - Pass  10 

NTRKA  is  incremented  to  10  which  is  not  greater  than  MTRKA  = 65,  IDETA  = 
1,  NSMA  = 3 which  is  not  greater  than  MSMA  = 8;  so  NSMA  is  incremented  to  4 
and  MAVGA  decremented  to  6.  NSMA  is  not  equal  to  zero  and  NPREDA  “ 9 which 
is  not  zero  but  is  greater  than  MPREDA  - 8;  so  the  Kalman  Angle  Tracking 
Filter  branch  is  entered. 

NPREDA  is  reset  to  zero  and  those  elements  of  the  state  transition 
matrix  dependent  upon  range  and  range  rate  are  computed  based  on  their  most 
recent  estimates.  The  driving  noise  covariance  element  which  is  dependent 
on  the  variance  of  the  range  estimate  and  on  the  filter  coordinate  rotation 
rates  is  computed  from  their  most  recent  estimates.  The  state  vector  is 
updated  for  time  zero  based  on  zero  Kalman  gains  and  then  predicted  1/16 
second  (time  1/16  second) . Similarly  the  system  covariance  matrix  is 
updated  for  time  zero  and  predicted  1/16  second.  This  completes  one  cycle 
of  the  filter  from  ASCOT  detection. 

3.3.11  Initial  Detection  - Passes  11-31 

Assuming  no  ASCOT  target  acquisition,  lACOA  remains  zero,  initial 
detection  passes  11-31  will  cyclicly  repeat  passes  1 through  10.  At  pass 
31  of  lACOA  = 0 (.19  + second  elapsed  time  from  detection),  the  ASCOT  will 
revert  to  its  search  mode;  that  is,  IDETA  = 0.  On  that  pass,  NEXTA  and 
NTRKA  are  reset  to  zero  and  MTRKA  to  31.  Upon  a new  target  detection  the 
initial  detection  process  will  repeat  as  previously  described. 

3.3.12  Initial  Detection  - Pass  32 

NTRKA  = 0 and  IDETA  = 0 so  that  the  data  smoothing  and  sequencing  logic 
are  bypassed.  The  SGAP  incremental  velocities  and  incremental  body  attitude 
changes  are  transformed  to  filter  coordinates.  Since  NTRKA  = 0,  the  incre- 
mental change  in  the  LOS  is  set  equal  to  the  measured  SGAP  incremental  change 
in  body  attitude.  The  smoothed  incremental  velocities  are  set  to  zero.  The 
filter -to-sensor  direction  cosine  matrix  (GCSF)  and  quaternion  (GQSF)  are 
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reset  to  their  fixed  search  values.  This  branching  continues  as  described 
until  a new  target  is  detected. 

3.4  ACQUISITION  MODE 


Reviewing  the  initial  detection  sequence,  it  is  seen  that  the  Kalman 
filter  update  branch  is  entered  every  tenth  pass,  when  NPREDA  = 9.  The 
remaining  nine  passes  simply  increment  NPREDA  by  one  each  pass  to  maintain 
the  proper  sequencing.  When  the  ASCOT  has  acquired  the  target  (lACQA  = 1) 
and  the  system  is  not  extrapolating  (NEXTA  = 0),  the  system  will  compute  a 
residual  and  a set  of  Kalman  gains.  This  occurs  only  when  NSMA  = 0.  Three 
fundamental  actions,  then,  are  performed  during  each  1/16  second  Interval 
when  the  filter  is  tracking:  1)  update  Kalman  Angle  Tracking  Filter; 

2)  increment  NPREDA  (idle  branch)  and  3)  compute  residuals  and  Kalman  gains. 
When  lACQA  is  set  to  one  by  ASCOT,  one  of  ten  sequences  of  the  above  three 
actions  is  entered  depending  on  the  value  of  NSMA  on  the  first  pass  after 
acquisition.  Table  3 summarizes  these  sequences  as  a function  of  NSMA  in 
the  first  pass  after  acquisition.  Note  that  for  the  Kalman  filter  updates 
occurring  when  the  initial  NSMA  is  less  than  4 the  Kalman  gains  are  zero. 
MAVGA  given  in  the  table  refers  to  the  number  of  ASCOT  samples  used  in  the 
computation  of  the  smoothed  measurement  at  the  time  the  Kalman  gains  are 
computed.  Note  that  by  the  titie  five  passes  have  elapsed  from  the  point 
of  computing  the  first  non-zero  Kalman  gains,  the  filter  has  transitioned 
into  its  normal  (non-zero  gain)  tracking  mode.  A complete  description  of 
the  tracking  mode  follows. 


TABLE  3 

ACQUISITION  SEQUENCE  SUMMARY 


MAVGA** 

First  Pass 
Conditions 

Pass  after  Acquisition 

NSMA 

NPREDA 

1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

10 

0 

6 

I 

I 

I 

c 

o 

• 

I 

I 

I 

I 

1 

CG&I 

9 

1 

7 

I 

I 

UD* 

I 

I 

I 

I 

I 

CG&I 

I 

8 

2 

8 

I 

UD* 

I 

I 

I 

I 

I 

CG&I 

I 

I 

7 

3 

9 

UD* 

I 

I 

I 

I 

I 

CG&I 

I 

I 

I 

6 

4 

0 

I 

I 

I 

I 

I 

CG&I 

I 

I 

I 

UD 

5 

5 

1 

I 

I 

I 

I 

CG&I 

I 

I 

I 

UD 

4 

6 

2 

I 

I 

I 

CG&l 

1 

I 

I 

UD 

3 

7 

3 

I 

I 

CG&I 

I 

I 

I 

UD 

2 

8 

4 

I 

CG&I 

I 

I 

I 

UD 

1 

9 

5 

CG&I 

I 

I 

I 

UD 

i 

Code 


I Increment  NPREDA  idle  loop 

UD  Kalman  filter  update  loop 

CG  Compute  Kalman  gams  and  average  measurement 

* Kalman  gams  are  /ero 

• • at  the  time  the  gams  are  computed 

',e/4  01//  /’ 
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3.5 


TRACKING  MODE 


Prior  to  entering  the  tracking  mode  the  following  control  variables 
must  be  set: 

IDETA  =•  1 - Indicates  that  ASCOT  has  detected  a target. 

lACQA  = 1 - Indicates  that  ASCOT  is  in  its  tracking  mode. 

NTRKA  > 0 - Indicates  that  the  tracking  filter  has  been  initialized 

and  is  sequencing  normally. 

NSMA  * 0 - Indicates  that  the  previous  accumulation  of  ASCOT 
measurements  has  been  reset  to  zero. 

NPREDA  = 6 - Indicates  that  a Kalman  filter  update  will  be  made  in 
3 passes. 

NEXTA  = 0 - Indicates  that  the  filter  is  not  in  its  extrapolation 
mode. 

INTRKA  8 0 - Indicates  that  the  filter  is  not  on  an  Initialization 
pass. 

3.5.1  Tracking  - Pass  1 

NTRKA  > 0,  IDETA  = 1,  lACQA  = 1 during  tracking.  The  ASCOT  is  providing 
pointing  error  voltage  measurements  to  the  filter.  These  measurements  are 
transformed  to  filter  coordinates  through  the  most  recent  estimate  of  the 
sensor-to-filter  coordinate  transformation.  NSMA  - 0 which  is  not  greater 
than  MSMA  = 8,  so  the  most  recent  pointing  error  voltage  measurements  are 
added  to  accumulated  measurements  (which  were  set  to  zero  on  the  previous 
pass).  NSMA  is  incremented  to  1.  INTRKA  is  equal  to  zero  so  NSMA  is  tested 
to  determine  whether  or  not  the  Kalman  gains  are  to  be  computed.  These 
gains  are  computed  every  tenth  cycle  if  lACQA  = 1 and  NSMA  = 0.  At  this 
point  one  set  of  ASCOT  measurements  has  been  accumulated  for  smoothing  and 
NSMA  = 1. 

Since  NPREDA  = 6 which  is  not  zero  or  greater  than  MPREDA  = 8,  NPREDA 
is  incremented  to  7. 

3.5.2  Tracking  - Pass  2 

NSMA  = 1 which  is  not  greater  than  MSMA  = 8,  so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  NSMA  is  incremented  to  2.  NSMA  is  not  equal  to  zero 
and  NPREDA  = 7 which  is  not  zero  or  greater  than  MPREDA  = 8,  so  NPREDA  is 
incremented  to  8. 


3.5.3  Tracking  - Pass  3 


NSMA  = 2 which  is  not  greater  than  NSMA  = 8,  so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  Note  that  three  samples  have  been  accumulated  at 
this  point  in  the  sequence.  NSMA  is  incremented  to  3.  NSMA  is  not  equal 
to  zero  and  NPREDA  = 8 which  is  not  zero  or  greater  than  MPREDA  » 8,  so 
NPREDA  is  incremented  to  9. 

3.5.4  Tracking  ~ Pass  4 

« 

NSMA  = 3 which  is  not  greater  than  MSMA  =»  8 so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  NSMA  is  incremented  to  4.  NSMA  is  not  equal  to  zero 
and  NPREDA  = 9 which  is  not  zero  but  is  greater  than  MPREDA  = 8,  so  the  16  Hz 
Kalman  Angl..^  Tracking  Filter  branch  is  entered. 

NPREDA  is  reset  to  zero  and  the  1/16  second  state  transition  matrix  is 
updated  based  on  the  most  recent  estimates  of  range  and  range  rate.  The 
state  vector  estimates  (for  time  9/160  seconds  in  the  past)  are  then  updated 
based  on  the  Kalman  gains  and  residual  measurements  computed  at  the  end  of 
the  previous  cracking  sequence.  (The  gains  will  be  zero  if  this  is  the  first 
pass  through  this  sequence.)  These  estimates  and  measured  ownship  incremental 
velocities  in  filter  coordinates  are  used  to  predict  the  state  vector  to  time 
1/160  seconds  into  the  future.  (The  prediction  was  over  an  internal  of  1/16 
second  - 9/160  to  + 1/160  seconds.)  Similarly  the  system  covariance  matrix 
Is  then  updated  and  predicted. 

3.5.5  Tracking  - Pass  5 

NSMA  = 4 which  is  not  greater  than  MSMA  - 8 so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  NSMA  is  incremented  to  5.  NSMA  is  not  equal  to  zero 
and  NPREDA  = 0 so  the  ASCOT  reorientation  command  computations  are 
executed.  NPREDA  = 0 which  is  not  greater  than  MPREDA  = 8 so  NPREDA  is 
incremented  to  1. 

3.5.6  Tracking  - Pass  6 

NSMA  = 5 which  is  not  greater  than  MSMA  = 8,  so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  MSMA  is  incremented  to  6.  NSMA  is  not  equal  to  zero 
and  NPREDA  =»  1 which  is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is 
incremented  to  2. 

3.5.7  Tracking  - Pass  7 

NSMA  * 6 which  is  not  greater  than  MSMA  = 8,  so  the  most  recent  ASCOT 
meaHiiroments  are  transformed  to  filler  coordinates  and  added  to  those  pre- 
viously aci'umulated . NSMA  'n  Iru  reinented  to  7.  NSMA  Is  not  eqiia!  to  zero 
and  Nl’KKDA  - 2 wlilcli  Is  not  zero  or  greater  tlian  Ml’KKDA  ^ 8 so  Nl’KIvDA  Is 
Incremented  to  3. 


3.5.8  Tracking  - Pass  8 


NSMA  = 7 which  is  not  greater  than  MSMA  = 8,  so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  NSMA  is  incremented  to  8.  NSMA  is  not  equal  to  zero 
and  NPREDA  = 3 which  is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is 
incremented  to  4. 

3.3.9  Tracking  - Pass  9 

NSMA  = 8 which  is  not  greater  than  MSMA  = 8,  so  the  most  recent  ASCOT 
measurements  are  transformed  to  filter  coordinates  and  added  to  those  pre- 
viously accumulated.  NSMA  is  incremented  to  9.  NSMA  is  not  equal  to  zero 
and  NPREDA  - 4 which  is  not  zero  or  greater  than  MPREDA  = 8 so  NPREDA  is 
incremented  to  5. 

3.5.10  Tracking  - Pass  10 

NSMA  = 9 which  is  greater  than  MSMA  = 8,  so  the  most  recent  ASCOT 
measurements  are  added  to  those  previously  accumulated  and  the  total 
accumulated  measurement  is  divided  by  MAVGA  = 10.  Thus,  the  average  of  the 
measurements  over  the  previous  ten  passes  has  been  computed.  NSMA  is  then 
reset  to  zero  and  MAVGA  to  10  (MAVGA  could  differ  from  10  depending  upon 
initial  entry  conditions). 

NSMA  is  zero  so  the  stored  ASCOT  reorientation  commands  are  sent  to  the 
Filter  Coordinate  Update  Subroutine.  lACQA  = 1 and  NEXTA  = 0 so  the  Kalman 
gain  branch  is  entered.  The  Kalman  gains  and  the  residuals  are  computed 
after  which  the  averaged  measurements  are  reset  to  zero  to  initialize  the 
succeeding  accumulation.  MTRKA  is  set  equal  to  N’...KA  to  prepare  the  filter 
for  possible  subsequent  extrapolation.  NPREDA  5 which  is  not  greater  than 
MPREDA  B 8 so  that  NPREDA  is  Incremental  to  6. 

3.5.11  Steady  State  Tracking  Sequence 

From  the  previous  pass,  NSMA  = 0 and  NPREDA  = 6 which  duplicates  the 
conditions  at  the  beginning  of  tracking  Pass  1.  Therefore,  Pass  11  is 
identical  to  Pass  1;  Pass  12  is  identical  to  Pass  2;  Pass  13  is  identical 
to  Pass  3;  etc.  This  cycle  will  be  repeated  every  1/16  second  until 
interrupted.  Interruption  can  occur  either  by  manually  resetting  the 
computer  (IRESET  = 1)  or  by  loss  of  ASCOT  lock  (lACQA  = 0 and  IDETA  = 0). 

The  operation  of  the  reset  mode  has  been  previously  discussed.  The  ATRACK 
extrapolation  mode  used  after  ASCOT  break-lock  is  discussed  in  the  next 
section. 

3.6  EXTRAPOLATION  MODE 

The  Extrapolation  mode  is  implemented  to:  1)  provide  a deflection 

voltage  to  position  the  ASCOT  search  field-of-view  and  2)  aid  in  Kalman 
Angle  Tracking  Filter  reacquisition  when  the  ASCOT  can  not  maintain 
tracking.  Loss  of  ASCOT  lock- on  is  signaled  by  the  ASCOT  setting  IDETA 
and  lACQA  to  zero. 


When  NTRKA  is  greater  than  zero  but  lACQA  = 0,  the  data  smoothing 
branch  is  bypassed  and  the  extrapolation  branch  is  entered  if  NTRKA  is 
greater  than  MTRKA  (see  3.3.1  and  3.5.10).  NEXTA  is  incremented  to  1. 

Since  NEXTA  is  less  than  MEXTA  = 320  the  accumulated  measurements  are 
zeroed  and  NSMA  is  tested  against  MSMA  = 8.  NSMA  can  be  any  integer  value 
from  0 to  9 and  is  incremented  each  pass  in  a manner  similar  to  the  initial 
detection  sequence.  This  provides  proper  sequencing  for  possible  subsequent 
reacquisition.  For  the  same  reason,  MAVGA  is  set  to  (10  - NSMA)  so  that  an 
incomplete  set  of  measurements  can  be  accommodated  during  reacquisition. 

The  following  paragraphs  discuss  the  effects  of  each  possible  NSMA  value  on 
the  first  pass  of  the  extrapolation  mode. 

Table  4 shows  the  extrapolation  sequence  as  a function  of  the  initial 
pass  condition  of  NSMA.  Note  that  when  the  initial  NSMA  is  less  than  4 a 
Kalman  filter  update  is  made  prior  to  zeroing  the  Kalman  gains.  This 
provides  for  effective  utilization  of  ASCOT  measurements  taken  prior  to 
break- lock. 


TABLE  4 

EXTRAPOLATION  SEQUENCE  SUMMARY 


First  Pass 
Conditions 


NSMA  NPREDA  1 


Extrapolation  Pass 


8 

9 

10 

I 

I 

ZG&I 

1 

ZG&I 

I 

ZG&I 

1 

I 

I 

I 

I 

I 

I 

UD” 

I 

UD** 

I 

UD** 

I 

I 

I 

I 

I 

I 

I 

I 

I 

I 

I 

IncrerDent  NPRE DA  idle  loop 
Kalman  filter  update  loop 
Zero  Kalman  gains 

Update  made  with  gams  and  measurement  previously  computed 
Kalman  gams  are  ?ero 


If  lock-on  Is  not  re-established  in  320  passes  (2  seconds) , NEXTA  will 
exceed  MEXTA  « 320.  This  sets  the  following  control  logic: 

o NTRKA  :=  0 - Indicates  loss  of  angle  tracking  filter.  ASCOT 
automatically  reverts  to  its  search  mode. 

o NEXTA  = 0 - Resets  NEXTA 

o MTRKA  » 65  - Resets  the  initial  acquisition  counter  limit. 

If  target  acquisition  reoccurs  within  320  passes,  lACQA  is  set  to  1 and 
ATRACK  enters  its  reacqulsitlon  mode.  The  differences  between  acquisition 
and  reacquisition  are:  1)  the  filter  states  and  covariance  are  not  re- 

initialized; and  2)  the  pointing  error  in  volts  must  be  confuted  as  the 
difference  between  the  target  location  at  detection  and  the  search  field 
pointing  command.  The  filter  takes  advantage  of  the  information  provided 
during  the  Kalman  Angle  Tracking  Filter  extrapolation  cycle.  ATRACK  provides 
automatic  synchronization  of  the  extrapolation  cycle  with  newly  available 
ASCOT  measurements,  as  previously  described  in  the  initial  acquisition 
sequence,  rather  thin  completely  recycling  the  filter.  This  speeds  the  re- 
acquisition  process  and  provides  for  full  utilization  of  the  Kalman  filter 
memory. 

When  ASCOT  detects  a target  while  ATRACK  is  in  its  extrapolation  mode 
(<  321  passes)  the  reacqulsitlon  sequence  is  initiated.  Extrapolation 
continues  after  detection  as  previously  described,  except  that  the  320  pass 
extrapolation  limit  is  bypassed.  This  is  done  to  allow  the  ASCOT  to  acquire 
when  detection  occurs  afterl.81  seconds  of  extrapolation.  For  a time  (up 
to  190  milliseconds)  after  the  new  detection  ATRACK  is  in  its  Initial  re- 
acquisition mode.  During  this  time  the  control  logic  is  sequenced  to  prepare 
AT^CK  for  subsequent  reacqulsitlon. 

When  lACQA  is  set  to  one,  ATRACK  enters  a sequence  similar  to  the 
acquisition  mode  (see  Subsection  3.4).  The  difference  being  the  fact  that 
the  ASCOT  measurement  is  computed  as  described  above.  After  MAVGA  computed 
measurements  have  been  accumulated  and  averaged,  NEXTA  is  reset  to  zero  and 
ASCOT  pointing  error  voltage  measurements  are  again  processed  as  in  normal 
tracking. 
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SECTION  4 SUBROUTINE  ECU  DESCRIPTION 


4.1  ECU  FLOW  CHART 

The  ECU  subroutine  flow  chart  is  presented  as  Eigure  3. 

4.2  RESET  MODE 

A reset  mode  Is  provided  to  automatically  reset  the  logic  and  parameters 
of  the  individual  ATS  subroutines  at  the  operator's  discretion.  In  the  case 
of  ECU,  IRESET  = 1 initializes  the  saved  ownship  earth-to-body  quaternion 
when  in  platform  mode  (IPLAT  " 1). 

4.3  ASCOT  COMMAND  MODE 

Subroutine  Eilter  Coordinate  Update  (ECU)  has  three  functions: 

1)  computes  ownship  body  attitude  changes  in  its  platform  mode,  2)  updates 
the  filter-to-sensor  quaternion  (GQSE)  and  direction  cosine  matrix  (GCSE) , 
and  3}  computes  ASCOT  pointing  voltages. 

4.3.1  ATS  St rap down  Mode 

This  mode  is  executed  when  the  ATS  system  employs  an  SGAP  for  the 
measurement  of  oxmship  body  attitude  changes.  This  mode  is  entered  when 
IPLAT  ■ 0.  Before  ASCOT  acquires  a target  (lACQA  = 0)  NTRKA  is  equal  to 
zero.  Therefore  the  predicted  filter-to-sensor  direction  cosine  elements 
required  to  compute  ASCOT  pointing  voltages  are  set  to  the  fixed  values 
computed  in  subroutine  ATRACK.  ASCOT  pointing  voltages  are  then  c >mputed. 

When  ASCOT  acquires  a target  (lACQA  = 1)  NTRKA  will  no  longer  equal 
zero  and  the  filter-to-sensor  quaternion  update  branch  is  entered.  The 
incremental  change  of  the  sensor  coordinate  system  with  respect  to  the 
filter  coordinate  system  is  computed  from  incremental  changes  of  the  filter 
coordinate  system  computed  in  subroutine  ATRACK  and  incremental  body  attitude 
changes  measured  by  the  SGAP.  The  filter-to-sensor  quaternion  is  then  up- 
dated for  next  1/160  second  interval  and  the  filter-to-sensor  direction 
cosine  matrix  is  computed.  The  quaternion  is  then  predicted  1/160  second 
into  the  future  and  ASCOT  pointing  voltages  are  computed  for  the  next 
measurement  interval.  This  cycle  is  repeated  every  1/160  second  until 
interrupted  either  manually  or  by  loss  of  ASCOT  acquisition  after  which  the 
system  will  recycle  as  previously  described. 

4.3.2  ATS  Platform  Mode 


This  mode  is  executed  when  the  ATS  system  employs  an  inertial  platform 
rather  than  a SGAP.  This  mode  is  entered  when  IPLAT  = 1.  The  sines  and 
cosines  of  ownship  earth-to-body  Euler  angles  are  measured  in  the  inertial 
system  and  the  earth-to-body  direction  cosine  matrix  is  computed.  OvTiship 
incremental  body  attitude  changes  are  then  computed.  The  remainder  of  this 
mode  is  identical  to  the  strapdown  mode  previously  described. 


35 


GQAEXS  (D^.S'SQRT  (t.'SCAE  (1.tl«GCAE  (2^)*GCAE  (3JI) 
GQAEXS  (2)-.2S‘(GCAE  (2.31-GCAE  (3JD/GQAEXS d) 
GQAEXS  (3)°.2S*(GCAE  (3.D-GCAE  lO)  GQAEXS  lt> 
GQAEXS  (4M.2SMGCAE  (U)-GCAE  (2.t))/GGAEXS  (1) 


GQAE  (1)=.S*SQRT  (1  < GCAE  !1  .II^GCAc  (2.21'GCAE  (3.311 
GQAE  (2)°.2S*(GCAE  (2.3)-GCAE  <3.2)'  GQAE  (1) 

GQAE  (3l=.2b*(GCAE  (3  D-GCAE  il.3i!  GQAE  (II 
GQAE  M)=.2b*lGCAE  (I.2I-GCAE  '2.1I1.C0AE  (II 

RT(1I=-GQAEXS  (2)*GaAE(1)<GQAEXsm*G0AE  (2I«GQAEXS  MrCQAE  (31 -GQAEXS  (3t*GQAE  (4) 
PT  (,  :=-GQAEXS  (3I*GQAE  (1I-G0AEXS(41*GQAE  (21‘G0AEXS  lirGQAE  <3I*G0AEXS  (2I‘GQAE  (41 
PT  (3I=-G0AEXS  (41*GQAE  m*G0AEXS(3l*G0AE  (21-GQAEXS  (2I*GCAE  (3WGQAEXS  (ll'GQAE  (4) 
PT  (4)°-GQAEXS  (11‘GQAE  m«GQAEX£(2l*GQAE  I2)*GQAEXS  (3)*GQAE  I3I<GQAEXS  (4I*GQAE  (4) 


FIGUI^E3 

SUBROUTINE  ECU  FLOW  CHART 


37 


AKIPTMI 

>1. 


I I 


CSAAM  > 2/ACOS  (PT  (411/DOn 
GSAAS  > SIM  IS*  C£AAR*00T3i 


OOlSOI-U 

GSAAA(IMrT(l)‘2.‘ 

GSAAR/GSAAS 


GSAAAI1I4. 

CSAAA(2t°3. 

GSAAAOl^a. 


GQAEXS  GQAE  (II 
GI3AEXS(2i‘>GQAE  (21 
GOAEXS  (3)  < GQAE  O) 
GQAEXS  HI  •GQAE  (41 


MTI 

V 

7o\ 

' 

GCSFXPd.IhGCSF  (I.ll 
GCSFXP(2.1)=GCSFl2.l) 
GCSFXP  13.11  GCSF  (3.11 


X$UAm>G$A«AI1l 
XSUU  Ol'GSAA*  QI-XSLU  21 
XSUU  0I*6SAA*  OI-XSLU  >31 


XQNF>1JSQRT<XQSFXP  0)**2*XQSFXP  (2)**2+XQSFXP(3)**2«XQSFX 


XILR>JS*IXSl«Alli**2*XSlAA{2l**2*XSLAAOI**2l 

XIIC>I.-5*IXILRI 

u»Mc  FaMf-i»S(Ma> 

' r Onntn^ 

60SFXPI1)*XILC*GQSF  II)-V(XSLA*  (I)*GQSF  (2I*XSLAA  =2;*GQSF  (3)*XSLAA  QI'GQSF  (4» 
6aSFXPi2l>XtlC*S0SF  (2J»3  IXSLAA  (li'GOSF  (tl-XSLAA  ii  'GQSF  KI*XSLAA  J3)  *GQSF  {3H 
GOSFXP  OI'XIIC*GOSF  (31*.S  iXSLAA  (1I*GQSF  I«1»XSIA A 12.  *GQSF  (ll-XSLAA  (3>  *GQSF  (21) 
60SFXPH1*XILC*G0SF  HI-.S  tXSUU  (1>*GQSF  (3)-XSLAA  <2i*GQSF  (2)-XSUA  Ot*GOSF  (111 


GOSFXP  (1)=XCSFXP  (D'XQNF 
GOSFXP  (2)>XQSFXP  I2)*XQNF 
GOSFXP  (3)°XQSFXP  (3)*XQNF 
GOSFXP  (4)>XOSFXP  (4)*XQNF 


XOSFS  (1)=GQSFXP(1)“2 
XOSFS  (2)=GQSFXP(2I"2 
XOSFS  (3)=G0SFXP  (3)**2 
XOSFS  I4)=G0SFXP(4)”2 


XONF>12SORTiGOSFXP  (1I**2*G0SFXP  (2»**2«GQSFXP  (3)‘*2*GOSFXP  (4I**2I 


GOSF  (1hGQSFXP(1)*X0»f 
GOSF  (2)»GQSFXP(2rXQNF 
GQSF{3l>GQSFXP(3l*Xa»F 
GQSF(4)‘GQSFXP(4rXQNF 


GOSFXP  (I.D^XDSFS  (1)«XQSFS  I2)-XQSFS  (3)-XQSFS  14) 
GOSFXP  )2,1)'2.*(GDSFXP  (2)‘GQSFXP  (3)-GQSFXP  (1)  ‘GQSFX 
GOSFXP  (3.1)=2.*(GQSFXP  0)*G0SFXP  (3)*GQSFXP  (2)  ‘GQSFX 

' ' Ascot  Pointing 
I r Voltage 

PT1  = DSFP/GCSFXP(1,1) 

EVTSSOI2)  = PTfGC$FXP(2.1) 

EVTSSC  (3)»PTrGCSFXP|3,1) 


XOSFS  (1)=GQSF(1)“2 
XOSFS  (2I=G0SF  (2I**2 
XOSFS  (3l*GOSF  (3)**2 
XOSFS  <4)=GOSF(4)**2 

Filter-toSeniof 
' r Oifect'sn  Cisine  Matrix 

GCSF{l.1l=XOSFSm*XOSfS(2l-XCS?S  31- XOSFS  (41 
GOSF  (U)=2.MG0SF  (I)’GOSF  (4)*GCSF  :i’GQSF  1311 
GOSF  (U)=^2.*IGOSF  (2)*GOSF  M)-GG3F  II'GOSF  (31) 

GOSF  (2.1)=2.*(GQSF  )2)*GQSF  (31-Gr.SF  ICGQSF  (4)) 
GOSF(2.2)=XOSFSn)-XQSFS(2)‘XQS?5l3‘-XQSFS(4) 

GOSF  (2^)=2.‘(GQSF  (D’GQSF  (2I*GGSF  2!*GQSF  (4)) 

GOSF  (3.1)=2.*(GOSF  (D'GQSF  (3I*GGSF  <:i’GOSF  (41) 

GOSF  (3  2)=2.*(GOSF  (3)*GOSF  (4)-G0SF  D'GQSF  (2)) 

GOSF  3)°XQSFS  (l)-XOSFS  (2)-XOSFS  3)»XOSF$  (4) 

Predict  Filter-to-Sensot 

' [ Qualetnion 

XOSFXP  (1)-XllC*GOSF  ())-  5*(XSLAA  (D’GOSF  (2)+XSLAA  (2fGOSF  (3)*XSLAA  (3)  *GQSF  (4)) 
XQSFXP  (2)=‘XILC"GOSF  (21*  5*(XSLAA  (1)*GOSF  (D-XSLAA  i2)‘GOSF  (4)+XSLAA  (3)  'GOSF  (3)) 
XOSFXP  (3)=X1LC*G0SF  (3)*.5*(XSLAA  (D'GQSF  (4)»XSLAA  l2fGQSF  (D-XSLAA  (3)  *GQSF  (2)) 
XOSFXP  (4)=XILC*G0SF  (4)-.S*(XbLAA  (D*GQSF  (3)-XSLAA  i2)*GQSF  (2)-XSLAA  (3)  ’GOSF  (D) 


XSLAA  (D’GSAAA  (t) 

XSLAA  (2)°GSAAA  (2)-XSLLA  !2) 
XSLAA  0)=GSAAA  (3)-XSLLA  i3l 


XQNF=1./SQRT(XQSFXP  (1)"2+XQSFXP  (2I*‘2+XQSFXP(3)*‘2+XQSFXP(4)"2) 


SRH'IUN  3 G'limniiTiNF  |trR5KT  DEEjClUn  jON 


5.1  DIRSGT  FLOW  CHART 

The  DIRSGT  subroutine  flow  chart  is  presented  in  Figure  4. 

5.2  RESET  MODE 

A reset  mode  is  provided  to  automatically  reset  the  logic  and  para- 
meters of  the  individual  ATS  subroutines  at  the  operator's  discretion. 

In  the  case  of  DIRSGT  muzzle  velocity  is  transformed  to  body  coordinates 
and  stored. 

5.3  OPERATIONAL  MODE 

Director  sight  computations  are  dependent  upon  the  availability  of 
angle  tracking  data.  Until  lACQA  = 1,  that  is  until  the  ASCOT  acquires  a 
target,  the  sight  computations  are  by-passed. 

When  lACOA  is  set  to  1 by  ASCOT  the  director  sight  computations  are 
entered.  There  are  four  basic  sight  computations:  1)  the  bullet  time-of- 

f light  computation;  2)  the  future  bullet  computation;  3)  the  future  target 
position  computation;  and  4)  the  lead  angle  computation. 

Bullet  time-of-flight  is  confuted  from  the  most  recent  estimates  of 
range  and  range  rate  computed  in  RTRACK..  Measured  ownship  velocity  and 
altitude  is  assumed  available  from  an  Air  Data  Computer  (during  ATS  flight 
test  these  inputs  may  be  input  data).  Future  bullet  position  is  predicted 
one  time-of-flight  using  measured  ownship  velocity  and  body  rates  and  the 
stored  muzzle  velocity.  Target  position  is  then  predicted  one  time-of- 
flight  using  the  most  recent  estimates  of  target  position,  velocity  and 
acceleration  computed  in  ATRACK.  Predicted  bullet  miss  distance  is 
computed  as  the  difference  between  predicted  bullet  position  and  predicted 
target  position  and  is  transformed  to  gunline  coordinates.  The  required 
lead  angle  is  then  computed. 

This  cycle  continues  until  interrupted.  Interruption  can  occur  either 
by  manually  resetting  the  computer  (IRESET  = 1)  or  by  loss  of  angle 
tracking. 
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FIGURE  4 

SUBROUTINE  DIRSGT  FLOW  CHART 
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